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Abstract 

The paper studies the visibility maintenance problem (VMP) for a leader-follower pair of Dubins-like vehicles with input 
constraints, and proposes an original solution based on the notion of controlled invariance. The nonlinear model describing 
the relative dynamics of the vehicles is interpreted as linear uncertain system, with the leader robot acting as an external 
disturbance. The VMP is then reformulated as a linear constrained regulation problem with additive disturbances (DLCRP). 
Positive D-invariance conditions for linear uncertain systems with parametric disturbance matrix are introduced and used to 
solve the VMP when box bounds on the state, control input and disturbance are considered. The proposed design procedure 
is shown to be easily adaptable to more general working scenarios. Extensive simulation results are provided to illustrate the 
theory and show the effectiveness of our approach. 
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1 Introduction 

1.1 Problem description and motivation 

This paper considers a number of visibility mainte- 
nance problems between autonomous vehicles. The sim- 
plest formulation is a leader-follower setup, in which 
both leader and follower are nonholonomic vehicles 
constrained to move along planar paths of bounded 
curvature, with limited positive forward speed. The 
follower vehicle's goal is to maintain the leader inside 
an appropriate sensing region. The theory of controlled 
invariance for uncertain linear systems is shown to be 
well suited for this objective as well as for achieving 
more involved tasks, such as, e.g., simultaneously reject 
unknown but bounded disturbances or preserve visibi- 
lity in multi- vehicle chain formations. 



We have two main motivations for the visibility main- 
tenance problems studied in this article. First, we are 
interested in surveillance and patrolling problems with 
formations of robotic vehicles in aerial and ground 
environments. We envision scenarios where a robot 
equipped with sensors with limited sensing footprints 
(such as, e.g., panoramic cameras, laser range finders, 
or high resolution radars) moves in such a way as to 
maintain a second moving target within its field of view. 
Second, this work is motivated by the need to design 
network-wide visibility and connectivity maintenance 
algorithms for groups of robotic vehicles. In the multi- 
agent network domain, connectivity is indeed a classic 
requirement necessary to guarantee the correct comple- 
tion of numerous distributed algorithms. 

1.2 Literature review 
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In the context of visibility maintenance between pairs of 
vehicles, two distinct literature domains are relevant to 
this work. First, visibility-based pursuit-evasion prob- 
lems for robots in complex environments have been in- 
vestigated in continuous-time in (Guibas et al., 1997; 
Gcrkey et al., 2006; Bhattacharya and Hutchinson, 2010) 
and in discrete-time in (Isler et al., 2005): in these works 



the vehicles' dynamic models are elementary and the 
proposed solutions arc not applicable to nonholonomic 
vehicles with limited positive forward speed. Second, 
the vast literature on aircraft pursuit-evasion has fo- 
cused much attention to game theory, optimal control, 
and numerical algorithms. A hybrid-systems and game- 
theoretic approach to aircraft conflict resolution is pur- 
sued in (Tomlin et al., 2000). Differential game problems 
between aircraft arc discussed in (Merz and Hague, 1977; 
Jarmark and Hillbcrg, 1984; Shima and Shinar, 2002). 
In (Glizer, 1999), a planar pursuit-evasion problem in 
which the target set is defined by a capture radius and 
constraints on the angular state variables (line-of-sight 
angle) is analyzed, and a necessary and sufficient con- 
dition for capture of the evader from any initial state is 
established using a variational method. However, differ- 
ently from the problem studied in this paper, the author 
considers constant positive forward speed for the non- 
holonomic vehicles and unlimited turning rate for the 
evader. More recently, in (Mazo Jr et al., 2004), the prob- 
lem of estimating and tracking the motion of a moving 
target by a team of unicycles equipped with directional 
sensors with limited range, is addressed using a hierar- 
chical control scheme. 

In the context of connectivity maintenance in multi- 
agent networks, the literature has experienced a recent 
spurt of growth (we refer to (Bullo et ai, 2009; Mcsbahi 
and Egerstedt, 2010) for recent surveys on this topic): 
two typical multi-agent tasks requiring network connec- 
tivity are "consensus" (Moreau, 2005; Olfati-Saber et 
al., 2007) and "rendezvous" (Cortes et ai, 2006; Lin et 
at, 2007). In this active research area, robots with li- 
mited communication capability are often modeled as 
transmitters with disks of finite radius. As the vehicles 
move to achieve a goal, it is generally hard to guaran- 
tee the connectivity among the members of the group 
is preserved over time. In terms of design, it is then re- 
quired to constrain robots' control inputs such that the 
resulting topology is always connected throughout its 
course of evolution. Potential fields and geometric opti- 
mization methods are the standard tools used in the lit- 
erature to address the connectivity maintenance prob- 
lem: a list of key references, yet far from being complete, 
is (Ando et al, 1999; Spanos and Murray, 2005; Ji and 
Egerstedt, 2007; Zavlanos and Pappas, 2007; Dimarog- 
onas and Kyriakopoulos, 2008; Savla et al., 2009; Yang 
et al, 2010). These works differ from the setup pro- 
posed in this paper in at least two important ways: first, 
the vehicle's dynamics is assumed to be locally con- 
trollable, and second, connections between two robots 
are bidirectional. In our problem, instead, we consider 
nonholonomic vehicles that are not locally controllable 
(they move forward with positive speed, along paths 
of bounded curvature) and we deal with sensor foot- 
prints such that the visibility links are not bidirectional. 
Wc finally point out that most of the works cited above 
do not explicitly account for robots' input constraints. 



1.3 Original contributions 

The basic setup considered in this paper consists of 
two nonholonomic agents: a leader (or evader) L and 
a follower (or pursuer) F. The robots can rotate with 
bounded angular velocity, but similarly to Dubins' 
vehicles (Dubins, 1957) can only move forward. The 
follower is equipped with a sensing device characterized 
by a visibility set S, a compact and convex polyhedral 
region encoding both the position and angle informa- 
tion. The leader moves along a given trajectory and 
the follower aims at maintaining L always inside its 
visibility set S, while respecting suitable bounds on 
the control inputs. Inspired by (Tiwari et al., 2004), 
where the concept of cone invariance is used to solve 
the multiagent rendezvous problem and by the results 
in (Blanchini, 1990; Blanchini, 1991), this paper ad- 
dresses the visibility maintenance problem (VMP) using 
the notion of controlled invariance. The key idea is to 
interpret the nonlinear model describing the relative 
dynamics of the leader and the follower, as a linear sys- 
tem with model parameter uncertainty, with the control 
input of the leader playing the role of an external di- 
sturbance. The VMP can then be easily reformulated as 
linear constrained regulation problem with additive dis- 
turbances (DLCRP). Positive V- invariance conditions 
for general linear uncertain systems with parametric 
disturbance matrix are introduced and used to solve the 
VMP when box bounds on the state, control inputs and 
disturbances are considered. Analytical conditions for 
the solution of the VMP are obtained by symbolically 
solving with the Fourier- Motzkin elimination method, 
the set of linear inequalities defining the polytopc of all 
the feasible state feedback matrices. The proposed de- 
sign procedure can be easily adapted to provide the con- 
trol with unknown but bounded (UBB) disturbances re- 
jection capabilities. Other extensions are also discussed: 
we present conditions for the solution of the VMP when 
robots' desired displacement is defined through angular 
parameters instead of distances, and extend the results 
valid for a leader-follower pair of robots to chains of 
n vehicles. Extensive simulation results illustrate the 
theory in the different working scenarios. The present 
paper builds upon (Morbidi et ai, 2008), compared to 
which wc provide herein a more detailed and extended 
theory, as well as a more accurate numerical validation. 

1.4 Organization 

The rest of the paper is organized as follows. In Sect. 2 
the linear constrained regulation problem is reviewed 
and new positive ©-invariance conditions for linear 
systems with parameter uncertainty are presented. 
In Sect. 3 we introduce the VMP and prove the main 
result of the paper. In Sect. 4 we investigate some exten- 
sions of the basic setup of Sect. 3. In Sect. 5, simulation 
results are presented. In Sect. 6 the main contributions 
of the paper are summarized and possible avenues for 
future research are highlighted. 
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2 The linear constrained regulation problem 

This section presents a series of results that arc 
instrumental in addressing the visibility maintenance 
problem in Sect. 3. Our exposition will basically fol- 
low (Blanchini, 1991): Theorem 10, Corollary 11, 
Theorem 12 and Corollary 13 extend the corre- 
sponding results in (Blanchini, 1990; Blanchini, 1991) 
(see also (Blanchini and Miani, 2008, Ch. 4)), to linear 
uncertain systems with parametric disturbance matrix. 
Consider the following system, 

s(t)=Ml(t))<t)+B(q(t))u(t), (1) 

where s(t) G X C M™ and u(t) G U C M m are respec- 
tively the state and input vectors, q(t) G Q C M p is the 
model parameter uncertainty vector, while IA, X, Q arc 
assigned sets containing the origin, with U and Q com- 
pact. We assume that A(q) and B(q) are matrices of suit- 
able dimensions whose entries are continuous functions 
of q. We will suppose q(t) to be a piecewise continuous 
function of time. 

Definition 1 (Positive invariance) The set S C R n 

is positively invariant for system (1), if and only if, for 
every initial condition s(0) G S and every admissible 
q(t) G Q, the solution obtained for u(t) = 0, satisfies the 
condition s(t) G S for t > 0. 

Definition 2 (Admissible region) A region S C M n 
is said to be admissible for the feedback control law u = 
Ks, if and only if, for every s G S, the condition u G IA 
holds. If IA and S are convex polyhedral sets containing 
the origin, the admissibility of S is simply equivalent to 

Kvi eU, Vi G vert(S), i G {1, . . . (2) 

where vert(S) denotes the set of vertices of S. 

We can now introduce the linear constrained regulation 
problem (LCRP), (Blanchini, 1991). 

Problem 3 (LCRP) Given a system in the form (1), 
find a linear feedback control law u(t) = Ks(t) and a set 
S C X such that, for every initial condition s(0) G S 
and every admissible function q(t) G Q, the conditions 
s(t) G X and u(t) G IA are fulfilled for t > 0. 

Theorem 4 The LCRP has a solution if and only if 
there exists a feedback matrix K and a set S C X that 
is positively invariant and admissible for the closed loop 
system 

s(t)=F(q(t))s{t), (3) 
where F(q(t)) = A(q(t)) + B(q(t))K. 

Theorem 5 (Sub-tangentiality condition) Let 

S G W 1 be a compact and convex set with nonempty in- 
terior. The positive invariance of S for (1) is equivalent 



to the following condition: for every sq G dS and q G Q, 

A(q) So eT s (s ), (4) 

whereT$(so) is the tangent cone toS atso (see (Blanchini, 
1999, Def. 3.1), and (Aubin and Frankowska, 1990, 
Ch. 4), (Aubin and Cellina, 1984, Ch. 5)) for more 
details). 

The main difficulty in exploiting condition (4) to study 
the positive invariance of an assigned region S is that 
it has to be checked on the boundary of S. However, if 
convex polyhedral sets are considered, only their vertices 
must be taken into account and easy algebraic conditions 
can be derived. In this respect, let us consider a system 
of the form (1), with 

p p 
A(q(t))=Ao + J2^i<li(t), B(q(t))=B + Y^B iqi (t), 
i=i i=i 

.(5) 

where Ai and Bi, I G {1, . . . ,p}, are constant matrices 
of appropriate dimension and q(t) takes values in a com- 
pact and convex polyhedron Qcl p , (qi(t) denotes the 
l-th component of vector q(t)). Let the set U be compact, 
convex and polyhedral as well. We consider a candidate 
compact and convex polyhedral set S containing the ori- 
gin in its interior and wc search for a feedback matrix K 
that assures the positive invariance of S for the closed 
loop system (3), (note that the previous assumptions on 
S will be retained throughout this section). Since S is 
polyhedral, then condition (4) is fulfilled on dS if and 
only if is fulfilled on every vertex of S. 

Theorem 6 The setS is positively invariant for system 
(3) with feedback u = Ks, if and only if, for all Vi G 
vert(S) and Wj G vert{ Q) : 

F(wj) Vi G T s (vi), i G {1, . . . , fj,}, j G {1,. . .,v}. 

The LCRP as formulated in Problem 3 does not require 
the stability. However, a desirable property is the global 
uniform stability of the closed loop system. The link be- 
tween the stability property and the existence of pos- 
itively invariant regions is established by Theorem 5.2 
in (Blanchini, 1991). 

Let us now turn our attention to systems in the form 

S(t) = A(q(t)) s(t) + B(q(t)) u(t) + E(q(t)) 6(t), (6) 

where the unknown external disturbance d(t) is con- 
strained in a compact and convex polyhedral set Del 1 
containing the origin. Note that with respect to the sys- 
tems considered in (Blanchini, 1991), the structure in (6) 
is more general inasmuch as matrix E also depends on 
the uncertain parameter q. As an immediate extension 
of the positive invariance property introduced in Defi- 
nition 1, we may require that the state s remains in S 
despite the presence of the disturbance 5(t). 
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Definition 7 (Positive D-invariance) The set S C 

K™ is positively V-invariant for system (6), if for every 
initial condition s(0) G S and all admissible q(t) E Q 
andS(t) G X>, the solution obtained for u(t) = 0, satisfies 
the condition s(t) G iS /or i > 0. 

We can now introduce the linear constrained regulation 
problem with additive disturbances (DLCRP). 

Problem 8 (DLCRP) Given a system in the form (6), 
find a linear feedback control law u(t) = Ks{t) and a set 
S C X such that, for every initial condition s(0) G S and 
every admissible q(t) G Q and 8(t) G V, the conditions 
s{t) G X and u(t) G hi are fulfilled for t > 0. 

Theorem 9 The DLCRP has a solution if and only if 
there exists a feedback matrix K and a set S C X that is 
positively V-invariant and admissible for the closed loop 
system s(t) = F(q(t)) s(t) + E(q(t)) 6(t). 

Similarly to (5), we will henceforth suppose that 
E(q(t)) = E + Y^a=i Ei qi(t). We are now ready to state 
the main theorem of this section. 

Theorem 10 (Main result) The set S is positive 
T>-invariant for system (6) with feedback u = Ks, 
if and only if, for all Vj G vert(S), ujj G vert(Q) and 
r k G vert(V), 



F(wj) v t + E(wj) r k G T s {vi), 

i G j G {l,...,v}, k G {!,..., T)}. 



(7) 



Proof: The proof is based on the same ideas as those in 
(Blanchini, 1990, Th. 2.1) and (Blanchini, 1991, Th. 4.1) 
(see also (Aubin and Cellina, 1984, Ch. 2, Sect. 4)) and 
the references therein). For the necessity, we have to 
prove that if S is a positive X>-invariant region for system 
(6), then condition (7) holds. The proof is straightfor- 
ward, since for the sub-tangentiality condition the posi- 
tive ZMnvariance of S for system (6) is equivalent to 



Let wij be the l-th entry of Wj . We have that 

F(q) Vi + E{q) r k = 

p p 

1i)r k 



1=1 

p V 



1=1 



p V 

1=1 3 = 1 1=1 j=l 

v p up 

=E ft [( F ° +i> ^-) v *] +E ft <%H] 

3 = 1 1=1 3 = 1 1=1 

=J2/3 j [F(w j )v i + E(w j )r k ], 

3 = 1 

i G k G {l,...,f?}. 

From (7) we have that J2j=i ft [F( w j) v « + E( w j) r k] £ 
T S (vi), i £ {l,...,Ai}, k G {1,...,T]}, therefore (9) 
is proved. If Hi is a delimiting plane of S for ,s (i.e., 
such that gf s = £j), we may write s as a convex 
combination of the vertices of S that belong to itf. 
s = 52h=i a hVh, with gfv h = & and ^^Li a h = 1, 
0<a h < l,he{l,...,tn}.ThengT(F(q)s + E(q)6) = 
9i(F(Q)EhUahVh + E(q)J2l =lPk r k ). But from (9) 
and recalling the expression of the tangent cone 
when S is described in terms of its vertices, we 
have that gf(F(q)vi l + E{q)r k ) < 0, that implies 
9i{F{q)YT t ^ l ah^h + E{q)Y2 =1 Pkr k ) < 0. By con- 
sidering all the planes for s, condition (8) follows 
immediately. I 
The application of Theorem 10 requires the knowledge 
of all cones Ts(vi), i G {1, . . . , fx}. An alternative solu- 
tion is given by the following corollary (whose proof is 
analogous to that of (Blanchini, 1991, Corollary 4.1)) 
in which the Euler auxiliary system associated to (6) is 
involved (cf. (Blanchini and Miani, 2008, Sect. 12.1)). 

Corollary 11 The set S is positively V-invariant for 
system (6), if and only if there exists r > such that, for 
all Vi G vert{S), ojj G vert(Q) andr k G vert(V), 



F(q)s + E(q)6 eT s (s), s £ dS, q E Q, 5 E V, (8) v i +r(F(w j )v i + E( Wj )r k ) e S, 



that trivially implies condition (7). For sufficiency, let 
us consider s arbitrary in S, q arbitrary in Q and S 
arbitrary in V. Supposing condition (7) holds, inclu- 
sion (8) has to be proved. We have that s = J2i=i a ' > 



E- =1 ft 



Y2=l Pk r k with Yh=i a i = 



Y,j=i ft = 1) Y, k =i Pk = 1, for some < a, < 1, i E 
{1, . . . , n}, < P 3 < 1, j G {1, . . . , v) and < p k < 1, 
k E {1, ... ,rj}. We first prove that 



F(q)v l + E(q)r k ET s (v l ), 

i E {l,...,fx}, q E Q, k E {l,...,r?}. 



(9) 



i E {l,...,/i}, j E k E {l,...,r?}. 



(10) 



To overcome the problem of the choice of r, we intro- 
duce Theorem 12 that provides a condition equivalent 
to (10). The proof is analogous to that of (Blanchini, 
1990, Th. 2.3). Let Ci be the convex cone defined by the 
delimiting planes of S which contain v^ (see (Panik, 1993, 
Ch. 4)) : 

C i = {9h s ^ £h, €h > 0, for every g{ 

and £h : g^v l = £ h , v t E vert (5)}. 
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Theorem 12 The set S is positively V-invariant for 
system (6), if and only if, for all r > 0, Uj G vert(S), 
Ljj G vert(Q) and r k G vert(T>): 

Vi + T(F(wj) Vi + E(wj) r k ) G Ci, 

i G {l,...,n}, j G {!,..., v}, k G {l,...,r?}. 

If the plane description of 5 is available, the next 
corollary, whose proof directly follows from that of 
Theorem 10, holds. 

Corollary 13 The set S is positively T>-invariant for 
system (6), if and only if, for every r > and every 
Vi G vert(S), ojj G vert(Q), 

(I n +TF(w j ))v l eC*, i G {l,...,fi}, j € 

(11) 

where C* is the cone obtained by shifting the planes ofCi 
as follows : 

C i = {fJh s < £h - m.scyi jk {Tg r ^E(w : j)r k }, iMj G vert(Q), 
r k G vert(T>), for every g^ : gf l v l = £/,}. 

Remark 14 According to Theorem 9, conditions (11) 
and (2) provide us with a set of inequalities in the un- 
known K defining the polytope K, of all the state feedback 
matrices solving the DLCRP. 

3 The visibility maintenance problem 

3.1 Modeling 

Let E = {Oo ; xo, yo} be the fixed reference frame in R 2 , 
and E F = {0 F ;x F , y F } and E L = {Ol;£l, the 
reference frames attached to a follower robot F and a 
leader robot L (see Fig. 1). The robots are supposed to 
have single integrator dynamics, 



Pf 



op , 

M F , 



Pi 



(12) 



where pp" = (x F , yF) T ', p\ = (el, yh) T are the posi- 
tions, a F = (a$[l],<r$[2]) T ,°l = (oHl],o^2]) r thelin- 
ear velocities and m f , wl the angular velocities of robots 
F and L in the frames E F and El, respectively. We are go- 
ing to derive a dynamic model describing the relative dy- 
namics of the robots F and L. Referring (12) to the frame 
Eo, we obtain (Siciliano et ai, 2008), p F = R F (0 F )cr F , 
pi = Rl(6 L )o-t, where 



R F (6 F ) ■ 



cos t) F — sin a F 
sin 9 F cos 8 F 



cos #l — sin 6>l 
sin 8 L cos 6*l 



Eo 



X-L 



!JL 



UP 



E 



V, x F 
9 F 



">~ 2^0 



Fig. 1. Leader-follower setup. 



The position of robot L with respect to Ep is then 
given by 

pi = R F Q (6 F )(pi-p F ) 7 (13) 

where R$(6 F ) = (R F (9 F )) T . Differentiating (13) with 
respect to time, we get 



Pi = R F (9 F )(p L -p F )+R F (8 F )(R L (e L ) o-l-R F (6 F ) a F 



Since 



(14) 



R F (Op) 



ujf 
-uf 



R F (9 F ), 



we can rewrite (14) as 



Pi 



M F 
-IMF 



pl + RlWl)al-a F , 



(15) 



where 0^ = 6l — f . Collecting equation (15) and the rel- 
ative angular dynamics of the robots together, we obtain 
the following system 



Pi 



PI 





pirn ' 


-h 






-Pim 





i— 1 



IM F 












RlWl) 




+ 












1 



M L 



(16) 



where p F = (pl[1], Pl[2]) t . For the sake of simplicity, 
we will suppose that 



(1+VF, 0) T , 
(1+«L, 0) T , 



(17) 



where \v F (t)\ < 1, \v L (t)\ < 1, for all t > 0. F and L will 
then behave in a way similar to Dubins vehicles since 



5 



they can only move forward (however, differently from 
the standard Dubins model, vf and vl are not necessarily 
constant in our case). Substituting (17) in (16), we finally 
come up with the following system 



After simple matrix manipulations in (18), we obtain 







'cos/31 - 1 




-i vim ' 


Pirn 




sin $1 


+ 


o -pI[i] 


. % . 









_ -1 



U)F 



cos Pi 
sm(3[ 
1 



i'L 



(18) 

with state vector s = (p[ [l],p[[2], /?£) T G X C SE(2), 
input vector u — (vp, top) T G U C (—1, 1) xl and 
disturbance vector 5 = (ul, ul) T S T> C (—1, 1) x M. 
System (18) describes the relative dynamics of the 
Dubins-like vehicles F and L in the configuration 
space SE(2). 



3.2 Problem statement 

In the forthcoming analysis, we will suppose that robot 
F is equipped with a sensor (e.g., a panoramic camera, 
a laser range finder, etc.) with limited sensing range. 
We will call visibility set of robot F any compact and 
convex polyhedral set S C X containing the origin in 
its interior. Please note that the visibility set generalizes 
the notion of sensor footprint since it encodes both the 
position and angle information. 

Robot L moves along a given trajectory and robot F 
aims at keeping L always inside its visibility set S, while 
respecting the control bounds. By referring to system 
(18), we can formalize this problem as follows: 

Problem 15 (Visibility maintenance problem: VMP) 

LetS be the visibility set of robot F and let s(0) G S. Find 
a control u(t) such that for all 8(t) G T>, the conditions 
s{t) G S and u(t) G IA are fulfilled for t > 0. 

In the following, we will refer to Problem 15 as to the 
VMP with candidate positively 2?-invariant set S, con- 
trol set U and disturbance set V. 



3.3 Solution method 

Next, we will transcribe system (18) into the linear para- 
metric form (6): in this way, the VMP simply reduces 
to the DLCRP (Problem 8) introduced in Sect. 2 and 
suitable solvability conditions can be derived by means 
of (11) and (2). 



ApE[lf 




pirn 









+ 







PE[2] 
-A P [[1] 
-1 



cos /3, 



sin/3* 



pirn 
pi 



cos ^1 
sin Pi 
1 



i'L 



which can be written in the form (6) with 



(19) 



(7 2 
A(q) = 1 + 9i 




E(q) 



where 

sin Pi 
9i = — !» 92 

Pl 



B(q) 



1 + 95 
96 
1 



94 
-d - 93 
-1 



(20) 



cosPf — 1 , „, , 

93 = A^[1], 



PI 



(21) 



q i =pl\2], q s = cos 01-1, q 6 =Bbx0[. 

We made the following change of variables in (19), 

( P l[l], P l[2],plf ^ (A P l[l], P l[2},plf, 

where Apl [1] = pl [1] — d and d is a strictly positive con- 
stant. Two main reasons motivated this transformation: 
first of all, if robot F is able to keep L always inside a vi- 
sibility set displaced of d with respect to its center (with 
d > max SlS2 g V ert(S) 5 ll s i — -^2 1 1 2 ) ^ then this automati- 
cally guarantees robots' collision avoidance. Second, this 
choice simplifies the study of the VMP with chains of 
robots (see Sect. 4.3). 

Notice that Aq, Bo and E$ in (20) (recall the notation 
used in Sect. 2) correspond to the constant matrices ob- 
tained by linearizing system (18) around the equilibrium 
s eq = (d, 0, 0) T , u eq = (0, 0) T , S eq = (0, 0) T . 
For the sake of simplicity, we will henceforth make the 
following assumption: 

Assumption 16 Suppose that (see Fig. 2) 

U = {(v F , lu f ) t : v F G [-V F , V f ], uj f G [-fi F) H F ]}, 

V = {(vl, lj l ) t : v L G [-Vl, Vl], lo l G [-fi L , fi L ]}, 

(22) 
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s 




(23) 



Fig. 2. The visibility set S in (23) and the pose of the robots 
L and F for ( Ap[ [1] , p[ [2] , pl) T = (0, 0, 0) T , d > a. 

S={(Apl[l],p[[2},Pir: ApftljGbo, a], 

p£[2]e[-a, a], $6 [-6, 6]}, 

where Vp < 1, Vl < 1, flp , fl^, a, b, are strictly positive 
constants. 

The definition (22) of control and disturbance sets is mo- 
tivated by the presence of saturation bounds on the driv- 
ing motors of physical robots. The candidate invariant 
set S is defined as in (23) because it is computationally 
simple to handle (this will allow us to provide concise 
solvability conditions for the VMP in Theorem 18), and 
because its horizontal section represents a reasonable 
good inner approximation of a disk sensor footprint e.g., 
due to an omnidirectional camera or a 360° laser scanner 
(the problem of precisely quantify the non-conservatism 
introduced by this approximation goes beyond the scope 
of this paper, and it is left as a subject of future research) . 
Finally, it is worth emphasizing that is not unusual in 
the multi-agent systems literature to encounter rectan- 
gular footprints, that are typically used, for example, to 
model "push-broom" or line-scanner sensors (see, e.g., 
(Finke et ai, 2005)). 

We now complete our transcription of system (18) into 
the linear parametric form (6), by defining an appropri- 
ate polyhedral set for the model parameter uncertainty: 



Q 



{(91,. 
92 6 [ 



,9e) T : 91 6^-1,0], 



cos 6—1 1— cos b~\ 



S — , — B — J ' 13 e I~ a ' a ] , 94 G [~a, a] , 
95 6 [cos b — 1 , 0] , 96 € [— sin 6, sin b] } . 

(24) 

It is easy to show that, if (Ap[[l],p[[2], /3£) T e S, then 
definition (21) immediately implies that q G Q. 

Remark 17 In the previous passages, the nonlinear 
system (18) has been absorbed into a linear (controlled) 
differential inclusion (see (Blanchini and Miani, 2008, 
Sect. 2.1.2)). This is an approximate transformation: 
however, no matter how the input u is chosen, we 



have that any trajectory of the original system (18) is 
also a trajectory of the corresponding linear uncertain 
system (the opposite is clearly not true in general). 
As a consequence, if we are able to determine the qualita- 
tive behavior of the absorbing system, we can determine 
(in a conservative way) the behavior of the original sys- 
tem. Some tools are available in the robust control liter- 
ature to quantify this conservativeness, such as, e.g., the 
recent nonlinear extensions of the gap and Vinnicombe 's 
i^-gap metrics (see (Bian and French, 2005; James et 
al., 2005) and the references therein). However, in the 
interest of brevity, we will not perform such an analysis 
in this paper. 

We are now ready to state the main result of this section. 

Theorem 18 (Solvability of the VMP) For the 

robots F and L, consider the VMP with candidate posi- 
tive T>-invariant set S, control set ti and disturbance set 
T> satisfying Assumption 16 with d > a, < b < n/2. 
This VMP has a solution if the following conditions are 
satisfied 



Vf > VL ( 1 



a sin 6 

d — a 



1 — cos b 



a b 

d — c 



_ (1-T4)sin& V L sinb + b 

"L S r- j ; S "F 

d + a d — a 



The state feedback matrix has the form 



(25) 



(26) 



K 



fcn 

fc 2 2 &23 



(27) 



where kn, k^i and fc23 belong to the polytope K C M 3 
defined by (30) -(31), (see the proof below) . 

Proof: Let us apply Corollary 13 to system (19). By se- 
lecting r = 1 in (11), we obtain 



1-^11+94^21 — fcl2 + 94^22 <72 - fcl3 + 94fc23 
— (d+ qi)k2i 1 - (d + 53)^22 1 + qi - (d + 93)^23 
— &21 — &22 1 — k'23 



Vi G C* 



(28) 



Condition (28) must be evaluated only on the vertices 
vi = (a, a, b) T ,y 2 = (a, a, -6) T ,v 3 = (a, -a, 6) T ,v 4 = 
(a, —a, — b) T since the set (23), whose plane representa- 
tion is 



1/a 
-1/a 



1/a 
-1/a 



1/6 





V 




1 




1 


s < 






1 




1 




1 
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s = (Apl[1]j Pl[2], /?l) T ' i s symmetric with respect to 
the origin. The cones C\ , . . . , C\ are given by 



The admissibility condition (2) leads to the additional 
constraints 



Vj, 


sin b 




a 


Vj, 


sin b 




a 


V L 


sin b 




a 


Vl 


sin b 



f^,ff 5 T s<l-^}, 

g%s<i- iJ t}- 



Cl = {gls<i-^,gis<i- 

C* 2 = {gfs<l-^,g^s<l- 

C* 3 = {gls<l-^,gjs<l- 

Ct = {gls<l-^,gjs<l- 
Condition (28) can then be rewritten as: 



a(l - kn + q 4 k 21 - fel2 + 94^22) + 6(92 - fci 3 + q 4 k 23 ) 
o(l - (fcai + fc22)(rf + 93)) + 6(1 + 91 - fc23(rf + 93)) 
-a(k 2 i + k 22 ) + 6(1 - fc 2 3) 

a(l - fen + 94^21 - fel2 + 94^22) - 6(92 - fel3 + 94^23) 
tt(l - (fcai + k 22 )(d + 93)) - 6(1 + 91 ~ k 23 (d + q 3 )) 
-a(k 2 \ + k 22 ) - 6(1 - /C23) 

a(l - fen + 94fe21 + fei2 - 94^22) + 6(92 - fci3 + 94^23) 
a(-l + (-fcai + k 22 )(d + q 3 )) + 6(1 + qi - k 23 (d + q 3 )) 
-a(k 2 i - k 22 ) + 6(1 - k 23 ) 

a(l - fcn + 94^21 + fel2 - 94^22) - 6(92 - fel3 + 94^23) 
a(-l + (-fe 2i + k 22 )(d + q 3 )) - 6(1 + 91 - k 23 (d + g 3 )) 

-a(fc2i - £22) - 6(1 - fc23) 

(29) 

Because of the special structure of B(q) in (20), we 
can select a simplified state feedback matrix K of the 
form (27): this allows to the decouple the control inputs 
vf and wp and visualize the polytope K, C K 3 of all the 
feasible gain matrices. We can then rewrite (29) in the 
following simplified form: 

- Kll + 94^22 + - 94 «23 < 92 , 

a a a 

b , , s , b . . Vj. sin b 

-(d + q 3 ) k 22 - - (d+ 93 k 23 < — (1 + 91 , 

a a a 

b , b Vl 

-kn + 94 «22 94 K23 < - 92 , 

a a a 

/ , \ t b , , . , 6 , . Vl sin 6 

-(d + 93) k 22 + -{d + 93) fc 23 < - (1 + 9i) • 

a a a 

a ft L 

«22 - «23 < , 

- fc 22 - K23 < — r- , 


-K11 - 94 K22 + - 94 «23 < -- 92 • 

a a a 

-kn - q 4 k 22 q 4 k 23 < - q 2 - — . (30) 

a a a 



ecf, 



ec 9 * 



6CJ 



Vt 

Q 



b n F 

k 22 H — k 23 < — , 
a a 

K22 k 23 > , 

a a 



K 22 K 23 S j 

a a 

& , M F 

k 22 + - k 23 > . 

a a 



(31) 



The Fourier-Motzkin elimination is a mathematical al- 
gorithm for eliminating variables from a system of linear 
inequalities. Elimination of unknown kij from the sys- 
tem of inequalities, consists in creating another system 
of the same kind but without fey , such that both systems 
have the same solutions over the remaining variables. 
If one removes all variables from a system of inequalities 
with numerical coefficients, then one obtains a system 
of constant inequalities, which can be trivially decided 
to be true or false. This procedure can then be used to 
easily check whether a given system admits solutions 
or not (see Appendix A for more details) . 
Applying the Fourier-Motzkin elimination to the in- 
equalities (30)-(31) with the assumption that d > a 
(in order to fix the sign of the coefficients of k 22 and 
&23 in the second and fourth inequality of (30)) we end 
up with the following conditions on the variables a, 6, 
d, Vf, Vl, Op, and uncertain parameters q±, ... ,q 4 
(the detailed passages are reported in Appendix B), 



^ ^ 6(l+qi) — Vl sin b 6(1+9i) + Vl sin b ^ ^ 
L — d+q 3 d+q 3 — F 



> Vi 1 



34 sin b \ 



b(q2 



94(1+91) ■ 



for <74 > . 



^>Vl(1 + ^)-% 2 + ^±^), forg 4 >0, 

V F > V L + bq 2l for q 4 = , 

^>Vl(1-^) + % 2 + ^^), for 94 <0, 

V F >V L (l-^)-b(q 2 + ^l) l for g4 <0. 

An appropriate selection of the parameters q\ , . . . , q 4 on 
the extremes of the intervals (24), (i.e., q\ = — 1, 
q 3 = a, for the first inequality, q\ = 0, q 3 = — a, for the 
second and q\ — 0, q 2 = 1 ^ cosb | q 3 = — a , q 4 = a, for 



the third), leads to (25) and (26) 

Some remarks are in order at this point. 
The inequalities (25) and (26) (which are linear in Vp, 
Vl, £If, f^L and nonlinear in a, b, d), specify the role 
played by each of the parameters introduced in Assump- 
tion 16, in the solvability of the VMP. In particular, they 
show how the bounds on the forward and angular veloc- 
ity of the follower robot are affected by the size of the 
visibility set S and the velocity of the leader. 
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Note that conditions (25) and (26) are necessary and 
sufficient for the linear uncertain system (19). Note also 
that owing to (26), we have f^F > Ql- Once fixed the 
variables a, b, d, Vf, Vl, Qf, according to (25) and 
(26), the polytope of all the feasible state feedback matri- 
ces is given by (30)-(31): by evaluating (30)-(31) on the 
vertices of the polyhedron Q, we can see that K. is defined 
by a set of 392 inequalities, most of whom are redundant 
(see, e.g., the external (green) polytope in Fig. 3, below). 

Remark 19 (Selection of the gain matrix K) 

Since the polytope K, contains infinite gain matrices, one 
needs an optimal criterion to select K, such as, e.g., 
minimizing any matrix norm. In the simulation experi- 
ments reported in Sect. 5, we have chosen the matrix 



K 



with minimum 2-norm. 



fcn 
k 2 2 k 2 3 



4 Extensions and applications 

In this section, we propose various extensions of the basic 
setup considered in Theorem 18, and discuss a few appli- 
cations. We study the VMP in the presence of unknown 
but bounded disturbances, and consider the case of the 
leader moving along a circular path around a stationary 
target. We also extend our results to chains of robots. 

4-1 Rejection of unknown but bounded disturbances 
Let us consider the following system 

cos 



aim 
pi 



-1 









PI 

Pi 



pirn 
pi 



+ 



pm 



-l-Apftl] 







-1 





Vp 






hp 


+ 









cos /3l — sin 
sin fjf cos pf 











1 



(32) 

With respect to (19), two new components, /if and /il, 
arc present in the input and disturbance vectors u and i5. 
They are unknown but bounded disturbances acting on 
the robots F and L (e.g., lateral wind in a real setup). 
Our purpose here is to solve the VMP in the presence 
of the disturbances hp, hi,. 

Collecting together all the perturbations acting 
on the nominal system (i.e., ul, wl, % and hif), 




Fig. 3. Polytopes /C for a set of given parameters: 
(blue, internal) with disturbances; (green, external) without 
disturbances. 

we can rewrite (32) as 













cos/3l-1" 






Pi 


am 










&l 


Pl[2] 


pi . 













. Pi . 



-1 PEP] 
-Apl[l]-d 
-1 



Wf 



cos^O 
sin/?£0 



1 

Let U be given in (22), and define 



-smfil 
-1 cos/?£ 



Ul-L 



hp 
(33) 



V={(v L ,u L ,h F ,h L y : v L e [-V L , Vl], 

ujl e [-n Lj n L ], h F e [-H F , Hp], h L g \-H u H h ]}, 

(34) 

where Hp, H^ are strictly positive constants. Using the 
same arguments as those in Theorem 18, we can prove 
the following corollary (note that the feedback matrix 
K is again of the form (27)). 

Corollary 20 (VMP with disturbances) Choose U 
andS as in Assumption 16, V as in (34), and let d > a, 
< b < tt/2. The VMP for the robots F and L in the 
presence of the unknown but bounded disturbances hp, 
h^, has a solution if the following conditions are satisfied 



V F > Vl 1 



•,s'mb 



+ 1 — cos b 



a(Hp + H L +b) 



(35) 



7?l shr b, 



9 



' sin 7 1— cos 7 



P 



P 




Fig. 4. VMP on a circle: pose of the robots L and F 
for (Ap[[l],ApE[2],A/3E) T = (0, 0, 0) T , v L = v F and 



Of > 



(l-VL)sinb -Cgg +g L ) 
d + a 

V L smb + b+{H F +g L ) 

d — a 



(36) 



Remark 21 TVoie that because of the additional terms 
Hp and Hi,, conditions (35)-(36) are stricter than (25)- 
(26) and then the polytope K is smaller in this case. This 
is evident in Fig. 3, where the polytope fC (blue, internal) 
obtained for a = 0.15 m, b = tt/3 rad, d = 1.6 m, Vi — 
0.95 m/s, Vi =0.1 m/s, F = tt/2 rad/s, fl L = tt/20 
rad/s and Hp = 0.2 m/s, Hi =0.1 m/s is compared with 
the polytope ( green, external) corresponding to Hi = 
Hp = m/s. 

4.2 VMP on a circle 

In this section, we will suppose that the leader robot 
moves along a circular path, around a static target. This 
scenario could be of interest in several real-world ap- 
plications, such as, e.g., for environmental surveillance, 
patrolling or terrain and utilities inspection (Casbeer et 
al, 2006; Susca et ai, 2008). Differently from Sect. 3.3, 
we will assume that the pose of robot L with respect to 
the frame of F is defined through the angle < 7 < n/2 
and the angular velocity p > 0, instead of the distance 
parameter d (sec Fig. 4). Let us consider the following 
change of variables in system (18): 

{pl[l],pl[2],f3l) T (Apl[l},Apl[2],A[3l) T , 
(vi,uji) t -> (vi, iOl) T , 
(v f ,uj f ) t -> (vp, Aw F ) T , 

where Afi[l] = p£[l] ^2, Ap[[2] = p£[2] - 

A/3^ = /?l — 7 and Au>i = oji — p. Aui F = iu-p — p. 
Following the same procedure detailed in the previous 
sections, we obtain the system 

















-1 


34 + 


+ 















p q2 — sin 7 
— p qi + cos 7 




1— cos 7 
P 

_ sin 7 
P 



where 



-1 

(12 



Aui-p 



A^[l] 

A/?l 

^5 + COS 7 

96 + sin 7 
1 



vi 
Acj l 



(37) 



_ sin(A/3L+7)— sin 7 

- apz 

_ cos(A^l +7)— cos 7 

- 



cos 7, 
- sin 7, 



q 3 = Apl[l], q 5 = cos(A(3l + 7) - cos 7, 
q A = Aj£[2], g 6 = sin(A/?F + 7) - sin 7. 

Assumption 22 Lei us suppose that 

W={(i' F ,Aw F ) T : u F g [-F F , Vf], Acj f g [-Op, fi F ]}, 
2?={K,Aw L ) T :i; L g [-Vi, Vi], Aw l g [-ft L , n L ]}, 

where < Vf < 1, < Vi < 1 andO < F} < fi L < p. 
Let us also consider the following visibility set (see Fig. 4 ) 



S = {(Apl[l],Apl[2],A(3ir: g [- 

Ap[[2] g [-a, a], A/f g [-6, 6]}, 

where a > and 6 > 0. 



(38) 



Since the state of system (37) is constrained in (38), the 
polyhedron Q C R 6 is defined as follows: 

_ r sin(fe+7)— sin7 sin(6— 7)+sin 7 1 

Qi g [ — ^ cos 7, — - — r 11 — 1 - COS7J, 

_ rcosfb+7) — COS7 , • — cos(fe— 7)+cos 7 

qi G[ — 2 +sm7, s— f- r - 



sin7], 



03 g [—a, a], 0.5 g [cos(6 + 7) — cos 7, cos(6 — 7) — cos 7], 

04 g [—a, a], q 6 E [— sin(& — 7) — sin 7, sin(6 + 7) — sin 7]. 

The proof of the next theorem is analogous to that of 
Theorem 18 and it is omitted. The feedback matrix K 
has also in this case the form (27). 

Theorem 23 (Solvability of the VMP on a circle) 

Choose IA, T> and S as in Assumption 22 and let 
1 — cos 7 > pa, < b ± 7 < tt/2. The VMP on a circle 
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So 



<] 








S3 





<5,, 



Fig. 5. Chain of n robots. 
has a solution if the following conditions are satisfied 

V F > V L (cos(6 - 7 ) + sin(b+ l 1 - c p °: 7 - pa) ) + cos 7 + 



pa 



1 — cos 7 — p a 



(sin(6 + 7) - sin 7 + pa) - cos(6 + 7), 



L <M (1 - yL)Sin(6 + 7) -l 



rip > p 



sm 7 + pa 

/ 14, sin(6 + 7) + sin(6 — 7) + sin 7 + pa 



sin 7 — pa 



(39) 



Note that differently from Theorem 18, in this case, 
owing to (39) is not always true (i.e., for all values of the 
parameters) that f2p > Ql. 



v l-Vi)sino2 K-isin6„ + 6„ 
"l — ; — ; > "n > ; > (41) 



<i 2 + 02 
and for all k € {2, . . . , n — 1}, 



a n 



sin&fc + b k (1 - Vfc)sin6 fe+ i 

S "fe S — ; ; ■ (, 4 ^J 



at 



dk+i + afc+i 



It is an easy task to verify that if a^ = a. b k — b, dk = 
d, k e {2,...,n} and V k = V, k 6 {l,...,n}, (a > 
0, d > a, < 6 < tt/2, < V" < 1), condition (42) 
(and condition (40) as well) is not satisfied. Nevertheless, 
it can be proved that if Vk and at least one of the three 
parameters defining the visibility sets arc left free to 
vary from robot to robot, then (40)- (42) can be always 
fulfilled. Fig. 6 shows the progression of a feasible set 
of parameters Vk, fifc, bk for a chain of n = 15 robots, 
when afc = a = 0.1 and dk = d = 7, k G {2, . . . , 15}. 
We conclude this section with the following corollary 
and a few remarks: 

Corollary 24 The chain of robots can hold only a finite 
number of agents and cannot be closed, i.e., robot 1 can- 
not cyclically pursue robot n. 

Proof: Let us study the connection existing between pa- 
rameters V\ and V n . After simple algebraic manipula- 
tions on (40), we obtain the following inequality: 



4-.S Chain of robots 

Next, we consider more complex robotic networks 
built by concatenating multiple leader- follower units 
(see Fig. 5). When equipped with wireless sensors, 
these arrays of robots could be used, for example, to 
efficiently monitor the temperature and/or salinity of 
the ocean or measure the average concentration of air 
pollutants (Lynch et al, 2008). In what follows, the 
feasibility conditions of Theorem 18 will be extended 
to such robot chains in order to maintain network-wide 
visibility between the agents. 

Because of the leader-follower hierarchy within the 
chain, vehicle k + 1 (the "follower") will aim at keeping 
the vehicle ahead (robot k, the "leader"), in its visibility 
set. Let a k , b kl d k , d k > a kl b k < tt/2, k € {2, ... ,n}, 
n > 2, be the strictly positive parameters defining the 
visibility set S k of robot fc-th and let < Vk < 1, £lk > 0, 
k G {l,...,n} be the bounds on fc-th robot's linear 
and angular velocities (recall Assumption 16). By prop- 
agating conditions (25)- (26) of Theorem 18 starting 
from robot 1 (that guides the formation), we obtain the 
following set of inequalities (linear in V k and flk) 



V < 



Vk+i > v k 1 + 



a k +i sin b k +i 



dk+i 
a-k+i Ofc+i 



dk 



+1 



Ofe+l 



, fcG{l, 



1 - cos6fc+i 



..,n-l}, 



(40) 



n 

i=i 



Oj sin&j 
di - a,- 



V„ 



1 — cos hi 



E 

i=2 



a, sin bi 

di - a. £ 



(43) 



n 

k=2 



Qfc sinbfc 
dk - a k 





v k 




ilk 




bk 




Fig. 6. Progression of a feasible set of parameters Vk, fife , 6fc 
for a chain of n = 15 robots (a k — 0.1, d k — 7, for all k). 
Angles are in radians. 
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2 4 6 123456789 10 0123456789 10 

Xo [m] time [s] time [s] 



(a) (b) (c) 

Fig. 7. Basic scenario: (a) Trajectory of the leader and follower, and visibility set <S; (b) Apl[1], Pl[2], /?l (solid) and bounds 
±a, ±a, ±& (dash); (c) vf, wf (solid) and bounds ±Vf, ±^f (dash). 



When the number of robots n tends towards infinity, the 
first term on the right-hand side of (43) converges to 
zero (for any choice of the parameters at, bi, di satisfy- 
ing the previous assumptions) asymptotically leading to 
the inequality V\ < 0, which contradicts the initial hy- 
pothesis of a strictly positive V\. On the other hand, if 
the chain of robots were closed, the following additional 
inequality should be satisfied 



Vl > V n 1 



a\ sin b\ 

d\ — CL\ 



1 — cos&i 



d\ — ai ' 



but it is incompatible with condition (43). ■ 

It is easy to prove from condition (43), that once fixed 
a rule for the evolution of the parameters defining the 
visibility sets (i.e., a k = f a (k), b k = f b (k), d k = f d {k), 
with f a , ft,, fd : Z>i — > R given discrete maps), an up- 
per bound on the maximum number of robots the chain 
can hold is given by the maximum positive integer N 
that fulfills the following inequality: 



N 

E 

i=2 



1 — COS bj 



n 

fe = i+l 



a k s'mb k 
dk - a k 



< 1. 



Note that once the state feedback matrices Ki, i € 
{2, . . . , n} of the robots have been established, the im- 
plementation of the control laws is totally distributed: 
in fact, each agent only needs to know the relative posi- 
tion and orientation of the preceding vehicle in the chain, 
to execute its control action. 



5.1 Basic scenario 

The simulation results reported in Fig. 7 refer to the 
basic scenario studied at the beginning of Sect. 3. 
The leader robot moves with velocities v^(t) = 
0.05 sin(i), u h (t) = |j cos(O.li). We set Vl = 0.1 m/s, 
SIl = tt/15 rad/s, Vf = 0.9 m/s, f2p = tt/3 rad/s, 
a = 0.4 m, b = 7r/4 rad and d = 2m, according to the 
conditions of Theorem 18 and we chose the gain matrix 
in K. with minimum 2-norm: 



K = 



1.5173 
0.3707 0.4925 



Note that since K is in the interior of IC, the asymptotic 
stability is assured (cf. Theorem 5.2 in (Blanchini, 1991)). 
System (19) has been initialized with 



{Ap[[l](0),p[[2](p),Pl{0)y j 



(0.3285, -0.1626, 0.1071) T . 



(44) 



Fig. 7(a) reports the trajectory of robot L and F and the 
visibility set S, (in order to have a temporal reference 
the robots are drawn every two seconds). Fig. 7(b) shows 
that [1] , Pl [2] i /3l (solid), keep inside the respective 
bounds ±a, ±a, ±6 (dash), as expected. Finally, Fig. 7(c) 
exposes that the control inputs i>f, wf (solid), respect 
the corresponding bounds ±Vp, ±f2p (dash). 



5 Simulation results 

Extensive simulation experiments have been performed 
to illustrate the theory and assess the soundness of 
the proposed approach. 



5.2 Rejection of unknown but bounded disturbances 

In the simulation results reported in Fig. 8, the 
leader robot moves with velocities «l(£) = 0.01, 



12 



„ 

a 



-4 
-6 



Leader 
Follower 



10 

X [m] 



(a) 



15 



£ 0.5 f 



faij 

£ -0.5 I 
<l 



fa J 

a, 



faj 



10 
time [s] 



(b) 



fa 
3 



10 
time [s] 



(c) 



Fig. 8. Rejection of unknown but bounded disturbances: (a) Trajectory of the leader and follower, and visibility set S; (b) Ap^Il], 
Pl[2], /3l (solid) and bounds ±o, ±o, ±6 (dash); (c) «f, (solid) and bounds ±Vf, ±Hf (dash). 




(a) 



6 

time [,s] 



(b) 



^ 0.5 

a 



10 12 S -0.5 



3 

< 



6 

time [a] 



(c) 



Fig. 9. VMP on a circle: (a) Trajectory of the leader and follower, and visibility set iS; (b) Apl[1], Ap£[2], A/?l (solid) and 
bounds ±a, ±0, ±6 (dash); (c) vf, Aljf (solid) and bounds ±Vf, ±Qf (dash). 



wl(^) = —■§) sin(0.08i). Unknown but bounded dis- 
turbances hh(t), /if(^) (uniform random noises in the 
interval (—0.1, 0.1)) act on the leader and the follower 
(recall Sect. 4.1). Owing to the conditions of Corol- 
lary 20, we chose Vl = 0.03 m/s, Ol = n/18 rad/s, 
V F = 0.95 m/s, fl F = tt/4 rad/s, H h = H F = 0.12 m/s, 
a = 0.4 m, b = tt/4 rad and d = 2 m. The initial condi- 
tion of system (33) is (44) and, again, we selected the 
gain matrix in K, with minimum 2-norm: 



5.3 VMP on a circle 

In Fig. 9, the leader robot moves with velocities 
Vh(t) = 0.05 sin(i), oo\,{t) = 7r/30, and the parame- 
ters Vl = 0.06 m/s, ft L = tt/25 rad/s, V F = 0.8 m/s, 
Hp = it/3 rad/s, a = 0.4 m, b = 7r/4 rad, p = 0.3 rad/s 
and 7 = 7r/6 rad, have been chosen according to 
the conditions of Theorem 23 (recall Sect. 4.2). 
The minimum 2-norm gain matrix in K. is, in this case 



K = 



1.6735 
0.5896 0.5326 



Fig. 8(a) reports the trajectory of L and F and the visibi- 
lity set S. From Figs. 8(b) and 8(c), we note that despite 
the presence of the unknown but bounded disturbances, 
Apl[1], 0E an d vf, wf respect the relative state 

and control bounds. 



K 



1.3812 
0.6051 0.5508 



and the initial condition of system (37) is (Ap][[l](0), 
Ap[[2](0), A/3£(0)) T = (0, 0, 0.5597) T . Fig. 9(a) re- 
ports the trajectory of L and F and the visibility 
set iS. Figs. 9(b) and 9(c) show the time history of 
Ap£[l], Ap£"[2], A/3£ and vp, Awp, and the correspond- 
ing bounds. 
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Fig. 10. Chain of robots: Trajectory of the 4 robots and (a) visibility set S2, (b) visibility set £3, (c) visibility set 1S4; (d) 
Ap?[l], P f[2], Pl (solid) and bounds ±a 2 , ±a 2 , ±b 2 (dash); (e) Apjj[l], p|[2], ^ and bounds ±o s> ±a Sl ±63; (f) Ap|[l], p*[2], 
/3| and bounds ±04, ±04, ±64; (g) V2, W2 (solid) and bounds ±V2, ±Q 2 (dash); (h) V3, L03 and bounds ±14, ±03; (i) 1)4, 0J4 
and bounds ±1/4, ±^4. 



5.4 Chain of robots 

In Fig. 10 a chain of 4 robots is considered (recall 
Sect. 4.3). Robot 1 guides the formation with veloci- 
ties, ui(t) = 0.01, = tt/52. The following set of 



parameters, satisfying conditions (40)-(42), has been 
used in the simulation: V\ = 0.02 m/s, V2 = 0.085 m/s, 
V 3 = 0.25 m/s, V 4 = 0.8 m/s, fij = tt/50 rad/s, 
^2 = 7r/35 rad/s, il 3 = n/21 rad/s, O4 = n/6 rad/s, 
and 02 = 03 = 04 = 0.4 m, 62 = 7r/14 rad, 63 = 7r/9 rad, 
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&4 = tt/4 rad and d 2 = d% = dj = 3 m. The minimum presence of visibility constraints. The use of polar coor- 
2-norm gain matrices in the polytopcs JC 2l /C3 and IC4 dinates to describe conic-like visibility sets <S, is also a 
of robots 2, 3 and 4, are respectively subject of on-going research. 



K 2 



0.2066 
0.0315 0.3361 



0.5087 
0.0669 0.3400 



Ka = 



1.7273 
0.2678 0.3348 



and the initial conditions for the three dynamic systems 
in the form (19) are. (Apf [l](0),pf [2](0),/3?(0)) T = 
(0,0,0.0374)*, (A^[l](0),pi[2](0),/? 2 3 (0)) T = (0,0, 
0.2244f, (Ap|[l](0),p|[2](0),/3 3 4 (0)) T = (0, 0, 0.2618) T , 
where p k +1 denotes the position of robot k with re- 
spect to the reference frame attached to robot k + 1 
and p k k +1 4 9 k -6 k+1 , k G {1,2,3}. Figs. 10(a)-(c) 
report the trajectory of the 4 robots and the visibility 
sets £2 (green), S3 (cyan) and £4 (gray), respectively. 
Figs. 10(d)-(f) and 10(g)-(i) show the time history 
of Ap* +1 [l], p k k +1 [2], p k k + \ k e {1,2,3} and v k , os k , 
k G {2, 3, 4}, and the relative state and control bounds. 



6 Conclusions and future work 

The paper proposes an original solution to the visibi- 
lity maintenance problem (VMP) for a leader-follower 
pair of Dubins-like vehicles with input constraints. 
By interpreting the nonlinear model describing the rel- 
ative dynamics of the robots as a linear system with 
parameter uncertainty, the VMP is reformulated as 
a linear constrained regulation problem with additive 
disturbances (DLCRP). General conditions for the 
positive D-invariance of linear uncertain systems with 
parametric disturbance matrix are derived and used 
to study the feasibility of the VMP when box bounds 
on the state, input and disturbance are considered. 
The proposed design procedure can be easily adapted 
to provide the control with unknown but bounded dis- 
turbances rejection capabilities. Conditions for the so- 
lution of the VMP when robots' desired displacement is 
defined through angular parameters are also presented, 
and the extension to chains of n robots is discussed. 
A drawback of the approach proposed in this paper is 
that it requires a great amount of computational work 
off-line, because the feedback matrix K is obtained as a 
solution of a large set of inequalities. In addition all the 
vertices of the visibility set S are required. In this re- 
spect, the solution to the LCRP proposed in (Vassilaki 
and Bitsoris, 1989) appears to be preferable to the 
one in (Blanchini, 1990), even though neither distur- 
bances nor model parametric uncertainty are considered 
therein. 

Future research lines include the extension of our re- 
sults to robotic networks with arbitrary topologies and 
the application of the proposed approach to the study 
of consensus, rendezvous and coverage problems in the 



Appendix A: 
method 



The Fourier-Motzkin elimination 



The Fourier-Motzkin elimination (FME), a generaliza- 
tion of Gauss elimination, is a computational method 
for solving a system 



Ax <b, AG 



b G 



of m linear inequalities in n variables (Motzkin, 1951; 
Schrijver, 1986). The key idea of the FME method is 
to eliminate one variable of the system A x < b at each 
iteration and rewrite the resulting equations accord- 
ingly. Even though the number of variables decreases at 
each step, the number of inequalities in the remaining 
variables grows exponentially fast: in fact, at iteration 
j the number of inequalities to be evaluated is at most 
L^J 21 . Because of its double-exponential computational 
complexity, the FME method can be applied efficiently 
only to problems with a small number of inequalities 
and it is not competitive with standard LP solvers 
However, differently from this numerical approach, the 
method can handle symbolic inequalities. We illustrate 
this idea with a simple example. Consider the following 
set of symbolic inequalities 



an xi + 012 x 2 < b\, 
-a 2 i X\ - a 2 2 x 2 < 62, 
032^2 < 63, 



(45) 
(46) 
(47) 



where an, a i2 , a 2 i, a 2 2, a 32 , 61, b 2 , 63 G M>o are un- 
known parameters. We wish to determine under which 
conditions on these parameters, system (45)- (47) admits 
solutions. The first step is to eliminate the variable x\. 
To this end, solving (45)-(46) in x\, we get: 



Xi < 



h - ai2 x 2 
an 



x-i > 



-b 2 - a 22 x 2 
an 



Joining the two inequalities, after a few computations, 
we obtain the following condition on the variable x 2 
(assuming that an 022 — a>vz a 2 i 7^ 0) 



x 2 > 



-an b 2 - a 2 i bi 
an 022 — Ol2 121 



(48) 



If we finally combine inequalities (47) and (48), we end 
up with the sought solvability condition of system (45)- 
(47), in terms of the symbolic parameters an, ai2, 021, 
a 22 , a 32 , 61, b 2 , 63: 



> 



032 



-an b 2 - 02i bi 

0-11 0-22 — Ol2 021 
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92 H 




a 
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.Yl 




92 H 




a 




a 



Appendix B: Application of the Fourier-Motzkin 
elimination to the inequalities (30)-(31) 

Our first step to solve the system of inequalities 
(30)-(31), is to eliminate variable fen. Solving in fen 
(under the assumption of d > a), we obtain the follow- 
ing set of conditions: 

fen > q 4 k 2 2 + ~ 94 k 2 3 + - 92 + — , 
a a a 

fell > 94 fc22 94 K23 92 H , 

a a a 



a 
b 



fen > , fen < — • 

a a 

Combining these inequalities, we get: 

, . V F b b V L 

qik 2 2 < 94fc23 92 , 

a a a a 

94 fe22 < h - 94 fe'23 + - 92 , 

a a a a 

Vf b , b V L 

94 K 2 2 > h - 94 K 2 3 + ~ 92 H , 

a a a a 

i Vf b b Vl 

94fe22 > 94fe23 92 H • 

a a a a 

In order to eliminate the second variable, fc22, we should 
consider three cases, according to the sign of 94. If we 
assume that > 0, we then obtain the following set of 
inequalities: 

h -> b l , b{l + qi ) + V L sinb 

k 2 2 > — fe23 H 77- v , (49) 

a a(d + 93 ) 

1 >> b 1 -b{l + qi) + VL sin b 

k 2 2 > - k 2 3 H 77- \ , (50) 

a a(a + 93) 

fc 22 > --fe 23 + -^, (51) 

, & , -V F + bq 2 + V L 

k 2 2 > - k 23 H , (52) 

a 094 

l. b U -VF-bq2 + VL r „. 
fc22 > fe23H , 53) 

a ag4 

fc22 > - fc23 , fe22 > fe23 l (54) 

a a a a 

fc22<-fc 2 3 -— , (55) 

a a 

/ ^ 6 ; Vf bq2 — Vl , , 

fe22 < — fe23H , (56) 

a 094 

, , b V F +bq2-VL , . 

fc22 < - fe23 H , (57) 

a 094 

b , fip , b , J7f 

fc 22 < — fe 23 + — , fc 22 < -fc 23 + — ■ (58) 
a a a a 



Combining conditions (49)-(54) and (55)-(58), we end 
up with a total set of 35 inequalities, of whom only 4 are 
non-trivial: 

_ &(l + gi)-V L sin6 & (1 + qi ) + V L sin& 

S2L S ; 5 "F ^ — 



V F > Vl 1 



+ b 92 + 



rf + 93 

94 sin 6 

- ~7 

a + 93 



ff4 sin 6 \ 

V F > V L 1 + ^- -6 92 

a + 93 



d+ 93 



94(1 + 9i) 
d + 93 

94(1 +91) 
rf + 93 



If we now assume that (74 = 0, we obtain the unique con- 
dition: Vf > Vl + b q 2 . Finally, if we assume that 94 < 0, 
we come up with the following inequalities 

, . b 6(1 + 91) + V L sin& 

fe22 > fe 2 3 + 77- ; , 

a a(d + 93) 

b -b(l + qi ) + V L sin& 

fe22 > - fe23 H 77- x , 

a a(d + 93) 

1 > b i- h ~-> b h , ^f-&92-Vl 

fe22 > fe23H , fe22 > fe23H , 

a a a aq± 

, . b VF + 692- Vl , . b n F 

K22 > - K23 H , «22 > - k 2 3 , 

a aq^ a a 

, . b F & fi L 

K22 > K23 1 K22 < - k 23 , 

a a a a 

, ,b 7 -V F + &92 + V L 

fe22 < - fe23 H , 

a 0,94 

, . b -V F -bq 2 + V L 

k 2 2 < fe23 H , 

a 094 

b ^f b fip 

K22 < k 2 3 H , K22 < - «23 H , 

a a a a 

from which we deduce the following two new conditions: 



V F >V L (1-^W92-' qi(1 + qi) 



V F > V L (l 
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